void single_colorring_test(){
  colorring_detection_loop(); //第1次检测色环
  Serial.print("第1次检测到的色环颜色为:");Serial.println(detect_msg.recv_colorring_one);
  delay(2000);
  colorring_detection_loop(); //第2次检测色环
  Serial.print("第2次检测到的色环颜色为:");Serial.println(detect_msg.recv_colorring_two);
  delay(2000);
  colorring_detection_loop(); //第3次检测色环
  Serial.print("第3次检测到的色环颜色为:");Serial.println(detect_msg.recv_colorring_three);
  delay(2000);
}

//


void corring_detection_test_now(){
  servo_move(51, 139, 160, 25, 1500);delay(1000);
  lift_move(45);delay(1000);
  servo_move(113, 139, 160, 25, 1500);delay(1000);
  servo_move(113, 73, 160, 25, 1500);delay(1000);

  colorring_detection_loop(); //第一次检测色环
  Serial.print("第1次检测到的色环颜色为:");Serial.println(detect_msg.recv_colorring_one);
  delay(2000);
  servo_move(113, 139, 160, 25, 1500);delay(1000);
  car_move(car_msg.forward, 0.15);

  servo_move(113, 73, 160, 25, 1500);delay(1000);
  colorring_detection_loop(); //第一次检测色环
  Serial.print("第2次检测到的色环颜色为:");Serial.println(detect_msg.recv_colorring_two);
  delay(2000);
  servo_move(113, 139, 160, 25, 1500);delay(1000);
  car_move(car_msg.forward, 0.15);


  lift_move(35);delay(1000);
  servo_move(113, 73, 160, 25, 1500);delay(1000);
  colorring_detection_loop(); //第一次检测色环
  Serial.print("第2次检测到的色环颜色为:");Serial.println(detect_msg.recv_colorring_three);
  delay(2000);
  servo_move(113, 139, 160, 25, 1500);delay(1000);

  lift_move(-80);delay(1000);
  car_move(car_msg.back, 0.3);
  servo_move(51, 139, 160, 25, 1500);delay(1000);
  delay(3000);
}